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ABSTRACT 


NASA is curiently investigating the use of robotic manipulators tor the 
mating and demating of umbilical fuel lines to the Space Shuttle Vehicle 
prior to launch. Force feedback control is necessary for this task in 
ordej to minimise the contact forces which will develop during mating. The 
objective of this project is to develop and demonstrate a working robotic 
force control system at Kennedy Space Center. 

Initial experimental force control tests with an ASEA IRB-90 industral 
robot using the system's Adaptive Control capabilities indicated that con- 
trol stability would be a primary problem. An investigation of the ASEA 
system indicated a 0.280 second software delay between force input commands 
and the output of command voltages to the servo system. This computational 
dela\ was identified as the primary cause of the instability. Tests on a 
second path into the ASEA’s control computer using the MicroVax II supervi- 
sory computer indicate that the time delay would be comparable, offering no 
stability improvement . All existing inputs to the ASEA control computer 
hardware were found to have too long of a delav for force control stabili- 
ty. 


An alternative approach was developed where the digital control system of 

the robot was disconnected and and an analog electronic force controller 
was used to control the robot's servo system directly. This method allowed 
the robot to use force feedback control while in rigid contact with moving 
three degree-of-f reedom target. Tests on this approach indicated adequate 
foice feedback contiol even under worst case conditions. A strategy to 
combine the analog force control system along with the existing 
digi t a 1 1 v-cont i o 1 1 ed vision system was developed. This requires switching 
between the digital controller when using vision control and the analog 
controller when using force control, depending on whether or not the mating 
plates are in contact.. 
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The Robot Application and Development Laboratory (RADL) at Kennedy Space 
Centex has been established to investigate robotic solutions to launch 
vehicle processing problems. The intent of the laboratory is to provide a 
testbed where robotic components can be used to develop workable engineer- 
ing solutions for hazardous and repetitive shuttle and payload processing 
activities • 

One such task is the mating and demating of umbilical fuel lines for the 
main tank of the Space Shuttle Vehicle vSSV). Presently* the umbilicals 
must remain attached to the SSV until slightly after launch, so that in 
case of a launch abort, the fuel can be rapidly removed to make the launch 
vehicle safe. Explosive bolts and a mechanical tear-off feature are used 
to disconnect the lines immediately after launch, offering the possibility 
of damage to the shuttle during launch. The present manual methods of 
reconnecting the fuel lines after a launch abort require over fifteen 
hours, and include numerous safetv problems to both the technicians and 
astronauts. The ability to use a robot to disconnect the umbilicals prior 
to launch and then reconnect them rapidly in case of an abort would offer a 
major improvement in launch safety, 

The umbilical mating problem places extensive demands on the sensory capa- 
bilities of the robotic system. First, the SSV is a dynamic structure, 
continually moving in a random fashion. Second, the mating problem 
ie quires high relative positioning accuracy between the umbilical connec- 
tors, Finally, the forces encountered during contact must remain low to 
avoid damaging either the umbilicals or the SSV, 

Three distinct phases must occur for umbilical mating using a robot. The 
first phase involves the use of vision tracking to allow the robot to 
approach and track the umbilical target. The second phase requires an 
actual mating process to occur. This will require a combination of mechan- 
ical guidance, compliance, and active force feedback control and is the 
least understood task of the problem, The third phase happens after a 
solid mating has occured. In this case, the random motions of the SSV must 
be duplicated by the robot using a force feedback approach to avoid large 
contact forces. Practically, the SSV must be able to lead the robot around 
such that the contact forces remain below a maximum tolerable value. 

A major goal of the RADL is to provide a feasibility demonstration of this 
capabi lit\ by using both force and vision information to dock and mate a 
simulated umbilical plate with a moving target. To do this, force feedback 
control will be required on the existing ASEA IRB-90 robot. 

Previous work on force feedback with the ASEA robot indicates a very high 
tendency for instability under operating conditions required by the umbili- 
cal mating problem. The goal of this work is to identify the instability 
problem, and develop a stable and effective force control system. 
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2.1 DAMPING CONTROL 


The theoretical dif icul ties of arbitrarily controlling a combined vector of 
force and position have been dealt with by several authors, as summarized 
in reference [1], However, the practical implementation of these 
approaches requires the implementation of extensive algorithms based on an 
accurate mathematical model of the robot. 

One simple vet quite effective approach to force control is that of damping 
control, also known as trajectory perturbation and accomodation control. 
With this approach, the velocitv of the robot is proportional to and in the 
direction opposite of the applied force, acting like a pure damping ele- 
ment. In effect, the robot moves so as to relieve the forces generated 
during contact. The proportional constant between velocity and force is 
defined by the force feedback gain Kf. 


2.2 DESIGN REQUIREMENTS 


Force control is required to both guide the umbilical lines in the cham- 
fered socket during mating a? well as allow the robot to track the dynamic 
motion of the SSV aftei mating. Contact forces under both conditions must 
not exceed the forces currently encountered during manual mating. For this 
studv, this value is assumed to be 60 pounds. A worst case estimate of the 
dynamic motion of the SSV [2] is a sinusoidal motion with a maximum ampli- 
tude of 6 inches and a frequency of 0.2 Hz., leading to a maximum speed of 
11 inches per second. Based on these requirements, the minimum value for 
the force feedback gain for tracking is 0.18 in. /sec. /lb. 

An inherent condition for anv control system is stability. An upper limit 
for the force feedback gain is selected to be one half of the gain for mar- 
ginal stability, providing a gain margin of 2.0. The control design 
problem is thus reduced to selecting a gain greater than 0.18 and less than 
half the marginal stability gain. 


2.3 STABILITY 


It has long been known that communication and computational delays in con- 
trol systems have an adverse effect on the system stability. This is 
especially true in the case of force feedback. For example, consider a pin 
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using fine* feedback control inside a 1 degree-of-f reedom hole. Without a 
delay in the force feedback signal, contact with one side of the well 
results in a command motion to move awav from the wall, with the commanded 
speed going to zero when the pin is centered. This behavior is demonstrat- 
ed in Figui t la. With a significant delay, the velocity, command always 
lags the force, resulting in an cases where the commanded velocity is in a 
direction which increases the contact force, as shown in Figure lb. This 
can result m instability. 

A very simple model is used to predict marginal stability 
01 der-of-magnitude estimates for both force feedback gain and time delay. 
The model assures ideal dynamics of the robot and no force interaction with 
the servo system. Using a time lag of 0.280 seconds as found in the ASEA 
controller, the maximum gain for stability is found as 0.015 in. /sec. /lb. 
This results in a maximum force feedback gain of .0075 with a gam margin 
of 2.0. This result is 24 times too low for proper force tracking. 
Requiring a value of 0.18 for the force feedback gain Kf results in a maxi- 
mum time delay of 0.044 seconds for stabilty. Note that both estimates do 
not take into account the robot's dynamics, and aie upper limits on piacti- 
cal values. 


2.4 SINGLE AXIS VS. Ml LTIPLE AXIS CONTROL 


The velocity response of the robot to an applied force should be directly 
opposite to the direction of the force. In general, this requires actively 
controlling all six axes. The ideal force-velocity relationship for damp- 
ing control therefore requires coupled response between the motor axes and 
the applied force. This multiple-input multiple-output (MIMO) relationship 
between the force vector and the axis velocity command is described by the 
kinematics : 


-1 

V - K * J (0) * F 

where : 

V is the desired velocity vector 
K is the damping control gain matrix 
J is the Jacobian matrix 
8 is the angular position of the links 
F is the measured force and torque vector 


A simplifying approach is to control individual axes which are relatively 
coupled to the TCF axes of the force/torque sensor. This can be represent- 
ed as : 


V = k i kl •• F 


where : 

V is the desired velocity vector 


ORIGINAL PAGE IS 
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K is the damping control gain matrix 

K) is a fixed coordinate transform in the force/torque sensor 
K K 1 is diagonal matrix 
F is the measured force and torque vector 

This approach allows each axis to be treated as an individual single-input 
single-output 'SISCO systems over a small range. 

This SISO approach will be used in this study due to simplicity. The 
requirements for implement at ion of the superior MIMO approach will be dis- 
cussed m the summary. 


11.5 COMPLIANCE 


Ari inherent requirement for the damping control approach is a degree of 
compliance m elasticity either in the robot itself 01 through the addition 

of an external compliant element between the applied force and the robot. 
Foi a stiff robot in contact with a rigid objects, the amount of motion of 
the robot need only !><■ a fee thousandths of an inch to cause a wide change 
in the force level. The addition of passive compliance can greatly 
increase the positional change for the same force level. In effect, the 
passive compliance decreases the force sensitivity to positional changes. 
Therefore, the force control algorithm must be able to operate under a wide 
range of possible compliance values. 

An experimental test was performed to determine the ASEA robots compliance. 
A lead screw was used to apply force the robot about the base rotation axis 
while under positional control of the robot's servo system. Force was 
measured using the JR3 six axis force /torque transducer while position was 
measured by a machinist’s dial indicator. The elastic coefficient for the 
robot in this position was found to be 407 +/- 15 Lbs. with a 0.015 inch 
backlash. This value is position dependent, but it provides an approximate 
baseline value for typical values. 


3.0 IMPLEMENTATION OF FORCE CONTROL 


3.1 ASEA CONTROLLER OVERVIEW 


The implementation of force feedback control depends completely on the 
capabilities built into the ASEA control computer. The controller is very 
well designed for industrial purposes, but can only use as designed by 
ASEA. Internal modifications in the controller software are impractical 
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due to ASEA’s insistance on not releasing software documentation due 
proprietary reasons. 


to 


The ASEA controller consists of two separate controllers, referred to as 
the eoutiol computer and the axis controller. The control computer deter- 
mines trajectories, system status, and performs kinematic calculations. 

sJrrmmriin contro1 cons | sts of * digital proportional position control loop 
surrounding an analog electronics velocity control loop for each link. The 

positional error determined by the digital controller of the ASEA is con- 
verted t0 a digital signal and used as a reference velocity command for 

LiiaL axis « 


! ll0WS 0nly tW0 paths for incorporating external sensory 
p ’ ferred t0 as Adaptive Control and Supervisory Control. An over- 
view ot the possible methods for force control is shown in Figure 2. 

The classical problem of gain versus stability is encountered. A 

sion^that^he^ traCkine is t0 ° laree for stability. The conclu- 

' that the , tlrpe delavs encountered using either the MicroVAX II or 
aptive Control inputs to the ASEA will not allow stable force control 
using values which would meet the force tracking capabilities of the robot 


3.2 ADAPTIVE CONTROL OPTION 


The ASEA robot has an input option designed for contour tracing, which 
implements a simple damping-based force feedback control algorithm This 

option, known as the Adaptive Control option, refers to adapting tta 
robot s trajectory m real-time due to external sensory input, rath^ than 
the more traditional designation referring to parameter adaptive controller 

^fUST SyStemS ' IhlS ln,> " , aI1 °” s direct f control from 

controller Th? Sens ° r sensor lnt0 analog communication port of the robot 
h J ' Thl l po ^ was Previously instrumented by the author [3] during 
the 1987 Summer Faculty program and is currently being used in a 3 DOF 
lead-around demonstration. u * u,f * 


^nU 0 l hlS it Or h a He OrU ? n a lly n de , SiBned b> ASEA to force feedback 

D of mimS , T baCkS - The adaptive control feature allows 3 

u.o.F. of MIMO force control m a rectangular (RECT) coordinate system 

eeping the orientation of the robot terminal device constant, as desired 
for umbilicai mating. However, a controller error causes a robot error 
ltmg motion of the robot. This is unacceptable in a contact situation.’ 

ufth° f t th fK M ° DRECT coordinate system uses a force controller which works 

wor^riell ir e ie«r bleTPS H „ bUt ^ ° n * SIS ° basis ‘ Again - this a PProach 
orks well m lead-around demonstrations, but has been previously shown to 

strains ^ COnUo1 gain Values within those required by the design con- 
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MICROVAC II PATH 



Figure 2. Possible Paths for RADI Force 
Feedback Control 








Test data was taken with a digitizing oscilloscope to determine the direct 
delav between the adaptive control input port and the command output to the 
seivo drive system indicated a delay averaging at 285 milliseconds. 


A classic demonstration of the effect of this delay on stability is provid- 
ed m liguies J and A. In both cases, force feedback was implemented using 
the adaptive control (contour tracing) feature of the ASEA. Only a sight 
change in the feedback gain determines whether the system is stable or 
unstable. Note that the marginally stable gain value for Kf of .018 
in. /sec. /lb. is 20 times (using an appropriate gain margin) below that 
required by the design specifications. Notice also the extensive delay 
lime between the foice measurement and the resulting servo command. 


contact with support engineers from ASEA indicate that they were unaware of 
the extent of this delay, and indicated that there is no immediate solution 
to this delay problem. Further, ASEA will not provide the means to modify 
to the controller software stored in EPROM or the software documentation. 


3.3 SUPERVISORY CONTROL 


The pnmarv path into the ASEA controller is through the Supervisory Con- 
ti ol method. This appioach allows an external computer to determine the 
trajectory of the robot and pass the command positions directly to the ASEA 
controller in an open loop fashion. This approach is presently being used 
sucessful ly with the 6 degree-of-f reedom (D.O.F.) vision control svstem. 

n this instance, positional errors are determined by a complex vision sys- 
tem, which passes these errors on to a MicroVAX II computer. This computer 
in turn passes the desired absolute position of the robot to the ASEA con- 
t roller through a communication protocol known as AHUP. 

This approach has several advantages for force feedback control. First 
all control calcualtions can occur in a single computer. Second, the force 
and vision control can be easily integrated. Finally, this approach allows 
or e implementation of a MIMO force feedback control algorithm in world 
coordinates for all six degrees of freedom, with the ASEA controller per- 
forming the necessary kinematic calculations. 

The problem with this approach is the extensive communication protocol 
h°fn JS® . AHUP . commu " icati °n Package along with the computational 
H P f f b °ii- the MlCloVAX 11 and the ASEA control computer. The extensive 
robot ° f 1? aPpr ° ach creates extreme difficulties in stabilizing the 


A rough estimate of the expected delav using this approach can be deter- 
mined bi using data from a test of the vision system delay time. In this 

alone wn ^ K1Ve " 3 St6p P° sitior ‘ al change which was recorded 
a ° * lth M the command to the analog servo system. Results are shown in 
Figure 5. Notice that there appears to be approximately a 350 millisecond 
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VOLTS VOLTS 



Figure 3. Force Feedback Control Stability Using ASEA Adaptive 
Control Force Feedback (Kf = 0.01b in/sec/lb) 



Figure 4. Force Feedback Control Stability Using ASEA Adaptive 
Control Force Feedback (Kf = 0.020 in/sec/lb) 
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Figure 5. MicroVax -ASEA Controller Time Delay 
Using Vision System 


delay between Initiation 
control signal. 


of the movement and the initiation of the servo 


control ^process^^along 5 wi^h^In® ^ ‘° mputation time for the vision 
encountered by £ “ h± ' h ^ 


til 1 MATED TIME DELAY COMPONENTS OF VISION SYSTEM 


time TASK 

( msec ) 


Camera refresh rate 

System 1000 processing 

System 1000 to MicroVAX II communication 

MicroVAX II and ASEA control delay 

Total Delay Time 


Result : 


MicroVAX II and ASEA controller delay: 274 msec 


Notice that the 
the Adaptive 


computer time delay is comparable to that encountered using 
Control inputs. Since force control through the MIcroVAX II 


30 


link can be no fastei than the present vision control algorithm, the con- 
clusion is that force control implementation using the MicroVAX II will not 
allow for stable force feedback control at gains which will allow adequate 
tracking . 


3.4 ADVANCED ALGORITHM DEVELOPMENT 


There has been onsiderable theoretical development in control theorv, 
including methods to handle stability problems associated with time delays 
[4]. The most commonly used approach is that of the Smith predictor, where 
a detailed model of the robot's dynamics without delay is used to predict 
the dynamic response and cancel the delayed value. Notice that this 
approach takes delay only out of stability argument, not out of system, and 
requires an accurate mathematical model of the dynamic behavior of the 
robot. Attempts were made to develop such a model. However , the 
signal-to-noise ratio of the measured variables was too low for simple non- 
stochastic modeling. There were also modeling problems associated with the 
nonlinearities of the system, including positional controller gain, back- 
lash behavior duung contact as well as position-dependent elasticity 
variations . 

Under such conditions, the identification required for an accurate model of 
the robot under contact conditions would require a considerable amount of 
engineering effort. With a simple model, the question of the algorithms 
robustness to modeling inaccuracies is in question. Esoteric approaches 
such as a parameter-adaptive Smith predictive control algorithms make for 
interesting research, but would prove very difficult to implement. 


4.0 ANALOG CONTROLLER APPROACH 


4.1 ALTERNATIVE APPROACH: AN ANALOG FORCE CONTROLLER 


The ASEA robot's digital control computer has an unavoidable 0.280 second 
delay and cannot be used for high gain force feedback control. One possi- 
ble approach to get force feedback control working is to bypass the digital 
controller entirely. This approach, referred to here as the "Analog Force 
Control (AFC) " approach, proposes an electronic hardware modification to 
the axis control of the robot. The approach takes advantage of digital 
position control /analog velocity control structure used by the ASEA con- 
troller. The digital position controller is physically disconnected and 
replaced by an analog velocity controller. Since this method uses analog 
electronics, the controller delay is completely eliminated. 
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Analog voltages fro- the force/torque transducer are conditioned in an ana- 
log electronic circuit, which would then inject a voltage into the summing 
junction of the velocity control feedback loop for each of the robot's 
motor through an external tachometer input line. 

By directly commanding the velocity of each motor to be proportional to the 
force, a single degree-of-f reedom damping control algorithm is implemented 
about each axis. 


4.2 IMPLEMENTATION 


By giving the motor a new velocity command, the digital position controller 
will determine that a positional error exists and therefore it will attempt 
to compensate for this. The combination of two controllers for one axis 
lesults in violent oscillations. The obvious solution is to simply remove 
the postion control input from the motor. The AFC therefore operates the 
robot without any position control from the ASEA. 

There are other practical problems which were overcome, including the elim- 
ination of the motor brakes. This was done by running a zero velocity move 
command program on the ASEA robot. Another problem included the strong 
noise on the analog control electronics of the ASEA, due primarily to the 
high frequency switching of the pulse-width modulated (PWM) power amplif- 
iers used for driving the motors. This problem was not able to be 
addressed due to the short time allowed for testing. 


4.3 POSITIONAL RESPONSE TESTS 


The initial test procedure for the AFC approach followed that used last 
year in determining the characteristics of the adaptive control of the ASEA 
robot. Initially, a square wave voltage was applied to each axis and the 
steady-state velocity was measured. The voltage-velocity relationship for 
each axis is: 


TABLE 1 

VELOCITY VS. VOLTAGE FOR DIRECT MOTOR CONTROL 


AXIS 

1 : 

147 

in. /sec. /volt 

AXIS 

2: 

41 

in. /sec. /volt 

AXIS 

3: 

65 

in. /sec. /volt 
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FORCE RESPONSE TESTS 


ORIGINAL PAGE IS 
OF POOR QUALITY 


The base rotation axis was initially used tor force control testing. A 
simple attenuation circuit was built to attenuate output voltages from the 
JRj force /torque sensor before being connected to the ASEA axis control 
board. An initial gain of 0.02 volts/volt was used. For base rotation, 
the relationship between the amplifier gain Ka and the force feedback gain 
is : 


Kf = 6.0 * Ka 

Initial lead around tests proved that the robot did respond in a damping 
control mode. In fact, the robot's motion was considerably smoother with 
this approach than with the similar Adaptive Control lead around demonstra- 
tion. 

Initial impact tests were performed where the robot was given a constant 
bias voltage simulating a specific force set point. The robot ran at a 
constant velocity until impacting a rigid table, where it would attempt to 
apply a constant force command. When this test was previously performed 
with the Adaptive Control feature of the ASEA, the robot would make con- 
tact, jump away from contact several inches, again approach at constant 
velocity, and repeat the cycle. The jump away from contact behavior, indi- 
cative of instability, was observed only tor very high force control gains 
with the AFC approach. 

Using the gain values observed from this test, a 1 D.O.F. stability test 
was performed using a pin attached to the robot with break-awav bolts. An 
experimental determination of the marginal stability gain was performed 
experimentally. Marginal stability occured with the electronic gain Ka set 
at 0.035 or equivalently a force feedback control gain of 0.21 in. /sec. /lb. 
Notice that this value falls within the previously defined design specifi- 
cations . 


4.5 1 D.O.F. FORCE TRACKING TESTS 


Force tracking tests were performed by using a single axis of an external 
three axis simulator table, designed to simulate the motion of the SSV on 
the pad. Typical test results are shown in Figure 6. Notice that the 
force appears 90 degrees out of phase with the position, or equivalently in 
phase with the velocity, as expected with the damping control approach. In 
this example, the force control gain Kf was set at 0.12 in. /sec . / lb . , which 
corresponds well with the maximum observed velocity/force ratio of 0.11 
in. /sec. /lb. Tracking tests were performed with speeds of up to 10.5 
in. /sec. with maximum force levels not exceeding 70 Lbs., indicating 
experimentally that the AFC approach can jointly meet both the tracking and 
stability requirements for force feedback control. 
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POSITION 



Figure 6. 1 D.O.F. Force Tracking Test 

(Kf = 0.089 in/sec/lb) 


Problems, occur when the range of travel along ari axis is large enough so 
that the angle between the insertion pin and the recepticle becomes large. 
The angle where this becomes unacceptable is dependent on the flexibility 
of the pin as well as the chamfer of the recepticle. However, the robot 
was able to maintain contact over the maximum range of travel expected by 
the SSV. This orientation problem in one area where passive compliance 
will be vital to the umbilical mating project. 


4.6 3 D.O.F. FORCE TRACKING TESTS 


With the success of the 1 D.O.F. controller, the testing of a 3 D.O.F. 
analog force controller was the necessary next step. In the 1 D.O.F. 
case, the motion of the base rotation of the robot (axis 1) was in the X 
direction of the force/torque sensor, allowing the direct (SISO) control of 
the axis from the X direction force measurement. However such orthogonal 
relation between the robots axis does not occur for the remaining Y (verti- 
cal and Z (inward i axes of the sensor. In effect, a MIMO solution must be 


For a specific robot corif iguation compatable with its position for contact 
with the simulator table, the motion of the second and third joints is 
approximately 45 degrees off the Y and Z axes, as shown in Figure 7. The 
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Figure 7. Force vs. Motor Axis Transform 



--- pi' tiansfon shown can appi oxidate ly relatt desired rectangular motion 
with the necessary joint motion for small deviations about this point. 

The electronic controller shown in Figure 8 was built to allow SISO control 
of Axis 1 as well as MIMO control of Axes 2 and 3. Offset adjustments were 
included for each motor, as was a set point bias on the Z axis to allow for 
a constant force set point in that direction. 

Again the system was tested in the lead around mode. The decoupling of the 
Y and Z motion was not exact, but was within 5 degrees and was considered 
sufficient for tracking testing with the three axis simulator. For these 
tests, a rigid pin with break-away screws was used. The robot was initial- 
ly guided into the recepticle, the force controller was started, and then 
table motion was begun. The robot was able to follow the table in all 
three axes, as shown in Figure 9 and on the videotape of the experiment. 
Due to a lack of time, only a cursory tuning of the second and third axis 
controller gains was performed. Therefore, tracking velocities for this 
test were lower than worst case conditions. Force levels remained fairly 
constant, reaching a maximum of 50 lbs. in the Y axis. This force is 
perhaps due to an axis bias problem. 


4 . 7 SUMMARY 


In summary, a simple 3 D.0.1. Analog Force Controller was built for 3 axis 
force feedback tracking of a moving target. The force control was suffi- 
cient in one axis to reach speeds of up to 10.5 in. /sec. while keeping the 
forces below 70 lbs. The ability to track in 3 D.O.F. was demonstrated. 
Due to a lack of time, only a simple demonstration could be developed. 
However, all evidence indicates that with some refinement, this approach 
should be able to meet the design conditions for 3 D.O.F. force feedback 
control of the robot. 


5.0 FUTURE DEVELOPMENT OF FORCE CONTROL FOR UMBILICAL MATING 


5.1 EXTENSION TO 6 D.O.F. 


The extension of this analog control approach to the orientation axes will 
require considerably more effort than the the simple analog force controll- 
er presented. The primary difficulty will be handling the coordinate 
transform between the force-torque sensor and the axes of the robot. This 
will require position information to be extracted from the ASEA. Further, 
the complexity of the MIMO interaction will be more difficult, resulting in 
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Figure 8. Analog 3 Axis Force Controller 
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Figure 9. 3 D.C.F. Force Tracking Test 


extensive interaction between the contact forces and the motion of the 
robot . 

On an applied note, the three oreintation axes use digital velocity control 
loops, rathei than analog loops, as used by the three proximal axes. This 
requires direct control of the analog current loop. Also, disconnecting 
these axes from the robot triggers an ASEA controller fault, shutting down 
the robot. All of these problems will require consderable effort to 
achieve. 

Note that there appears to be no immediate need for active orientation con- 
trol for the initial umbilical mating test. Passive compliance should 
prove satisfactory foi the short term. 


b.2 FUTURE WORK ON FORCE FEEDBACK CONTROL 

The following is a list of future tasks designed to improve the performance 
of the Analog Force Controller. 

1. Professional construction of analog electronics controller card. 

2. Electronical 1 v switchable robot interface. 

3. Noise identification and supression in electronics. 
k. Circuit diagram of Op-Amp input to ASEA axis board. 
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5 . Better joint coordination design. 
b. Model for contact force. 

7. Model-based controller tuning. 

8. Integration with passive compliance. 

9. b D.O.F. axis control investigation. 


5.3 COMBINATION OF VISION AND FORCE 


In the prototype umbilical mating tests, the force controller must work in 
conjunction with the existing 6 D.O.F. vision system. The integration of 
the two has been delayed until both force and vision have been capable of 
operating separately. The following is a possible senario of how vision 
can be combined with the 3 D.O.F. analog force controller. 

POSSIBLE VISION/FORCE MATING PROTOCOL 

1. 6 D.O.F. vision system brings robot to within force capture aper- 
ture . 

2. MicroVAX II initiates control changeover from vision to force 
control by triggering electronic switchover to analog control of 
robot . 

3. Strong force bias in Z direction from analog board moves robot 
into contact with target chamfers, force control in X and Y direc- 
tions guides the robot to mated position. Passive compliance 
handles the orientation misalignments. 

4. MicroVAX triggered collets rigidly attach flight-side and 
ground-side umbilical plates. 

5. Bias in Z direction removed, force control allows robot to track 
motion of SSV. 

6. MicroVAX triggers demate by first requests position information 
from ASEA controller to be used as a new baseline position for 
vision system. 

7. MicroVAX switches control from analog to ASEA digital controller 
using vision system for withdrawl of robot. 
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5.4 SAFTEY 


xs a safety problem inherent any time two objects are in contact. 
This is especially true of the ASEA robot when used with the Analog Force 
Controller. To avoid injury, the analog controller should only be used by 
NASA and contractor personnel. One person should always be in direct con- 
tact with an emergency stop button. For protection of equipment, 
break-away pins should be used along with suitable current limits for both 
the robot and the simulator table. 


5.5 CONCLUSIONS 

The ASEA controller is not capable of providing high-speed sensory control. 
Efforts to use the force/ torque sensors with the MicroVAX II for force 
feedback control will encounter instability problems similar to those 
encountered with the Adaptive Control functions of the robot. Force feed- 
back will not work through either adaptive control port of ASEA or the 
MicroVAX II path without extensive control system development to provide 
compensation for the software lags in the ASEA controller. 

An alternate solution is to switch the existing servo control system 
between the digital and an additional analog controller for force feedback 
control. This form of force feedback control has been demonstrated to pro- 
vide satisfactory performance for three D.O.F force feedback control 
without using passive compliance devices. 

The 3 axes of AFC system can be coupled with passive compliance for the 
orientation axes and the vision system for initial target approach to 
satisfy a preliminary remote umbilical demonstration. However, the 3 
D.O.F. analog force controller is not a very satisfactory solution, and 
future developments requiring force feedback control will be severely lim- 
ited. 
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